#include "board_config.h"
#include "board_gpio.h"
#include "platform.h"

GPIO_TypeDef* GPIO_PORT[LEDn] = {
#if LEDn > 0
	LED1_GPIO_PORT
#if LEDn > 1
	,LED2_GPIO_PORT
#if LEDn > 2
	,LED3_GPIO_PORT
#if LEDn > 3
	,LED4_GPIO_PORT
#endif
#endif
#endif
#endif
};

const uint16_t GPIO_PIN[LEDn] = {
#if LEDn > 0
	LED1_PIN
#if LEDn > 1
	,LED2_PIN
#if LEDn > 2
	,LED3_PIN
#if LEDn > 3
	,LED4_PIN
#endif
#endif
#endif
#endif
};

void board_led_init(void)
{
	GPIO_InitTypeDef  GPIO_InitStruct;
#if LEDn > 0
	LED1_GPIO_CLK_ENABLE();

	GPIO_InitStruct.Pin = GPIO_PIN[0];
	GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
	GPIO_InitStruct.Pull = GPIO_PULLUP;
	GPIO_InitStruct.Speed = GPIO_SPEED_FAST;
	HAL_GPIO_Init(GPIO_PORT[0], &GPIO_InitStruct);
	board_led_off(0);
#if LEDn > 1
	LED2_GPIO_CLK_ENABLE();
	GPIO_InitStruct.Pin = GPIO_PIN[1];
	HAL_GPIO_Init(GPIO_PORT[1], &GPIO_InitStruct);
	board_led_off(1);
#if LEDn > 2
	LED3_GPIO_CLK_ENABLE();
	GPIO_InitStruct.Pin = GPIO_PIN[2];
	HAL_GPIO_Init(GPIO_PORT[2], &GPIO_InitStruct);
	board_led_off(2);
#if LEDn > 3
	LED4_GPIO_CLK_ENABLE();
	GPIO_InitStruct.Pin = GPIO_PIN[3];
	HAL_GPIO_Init(GPIO_PORT[3], &GPIO_InitStruct);
	board_led_off(3);
#endif
#endif
#endif
#endif
}

void board_led_on(uint8_t led_id)
{
	if (led_id >= LEDn)
		return;
	HAL_GPIO_WritePin(GPIO_PORT[led_id], GPIO_PIN[led_id], GPIO_PIN_SET);
}

void board_led_off(uint8_t led_id)
{
	if (led_id >= LEDn)
		return;
	HAL_GPIO_WritePin(GPIO_PORT[led_id], GPIO_PIN[led_id], GPIO_PIN_RESET);
}

void board_led_toggle(uint8_t led_id)
{
	if (led_id >= LEDn)
		return;
	HAL_GPIO_TogglePin(GPIO_PORT[led_id], GPIO_PIN[led_id]);
}
